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Background and History 





TERCOM conceived by Chance-Vought in 1958 
— Later and still applied to cruise missiles (e.g. Tomahawk) 


A Kalman filter based system suggested by Hostetler in 1976, 
developed into SITAN by Sandia National Laboratories 


— AFTI/SITAN: F16 terrain navigation 1985 
— HELI/SITAN: helicopter terrain navigation 1990 


TERPROM a fusion of TERCOM (initial mode) and SITAN (track mode) 
developed by BAE systems during the 80s 


FFI generalisation of SITAN algorithm for bathymetric navigation 
(developed independently) in 1997 by Heyerdahl and Kloster 


— Developed into TRIN: AUV terrain navigation with DVL in 2001 


Non-linear Bayesian approach by Bergman in 1999 for aircraft terrain 
navigation (SAAB) 


— Point mass filter (PMF) and particle filters 


Why use Terrain Navigation? 





e Surface and Air applications: GPS is available 
— Redundant navigation system in critical systems 
— Navigation system integrity 
— Backup navigation system during GPS fall-outs or jamming 
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Why use Terrain Navigation? 





e Underwater applications: 


— GPS Is not available 


en — Deepwater: GPS fix not feasible 
— Shallow water: GPS fix possible 
e Not in covert operations 


— No infrastructure required 
e DGPS-USBL requires a mother ship 
e LBL/ UTP requires transponder(s) 
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Basic Principles e Lose integration 


— Navigation system data are 
combined with terrain 
measurements 


— Correlated with the expected DTM 
value in a search area 


— A Position solution is produced and 
passed back to the Navigation 
system 


e Algorithms: 
— TERCOM 
— Point Mass Filter 
— Particle Filters 


e Usually batch within ping 
— Batch over time interval possible 
— Recursive possible 








Basic Principles + Tight integration 5 
— Terrain sensors are integrates | 
along with Nav sensors 


— Correlated with the expected 
DIM value of current 
navigation solution 


— Full navigation solution is 
produced 


e Algorithms 
— Kalman filter based 
— TRIN 
— SITAN 


e Always recursive in time 
— Batch within ping possible 





Underwater Measurement Geometry 


Sensor Depth 
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Sensor ensonifies a 
seafloor area 


— The footprint 


Slant range and angles 
are computed 

— Ray bending 

— The beam vector 


The beam vector is 
transformed into a body- 
fixed earth tangent plane 
sysiem 


— Relative depth 


Further transformed into 
a Global Reference 
system 


— Global depth 


Underwater Vertical Reference 
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Vehicle ref point 





Pressure sensor 
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The vehicle measures 
pressure 


Vertical reference error 
directly adds to seafloor 
depth estimate error 


— Correlated between 
each beam 


— Correlated in time 


Slow-changing bias is ok 
— Tidal wave error 


— Atmospheric 
pressure error 


— CTDerror 


Dynamic pressure error 
is not ok 


— Waves 























Bathymetric sensors 














Multipeam Echosounder (MBE) 
— Across track profile at each ping, a fan of beamvectors 
— EM3000 tested from surface ship and Hugin AUVs 
Doppler Velocity Log (DVL) 
— 4 beamvectors in Janus configuration | 
— RDI WHN 300,600,1200 tested on AUVs (Hugin, OEx, Remus) 





Single Beam Echosounder 

— Large footprint 
Interferometric SAS 

— High resolution 
Underwater Laser Camera 

— High accuracy, low range 
3D Sonar 

— Surface at each ping 








Digital Terrain Models 


Algorithm requirements 
— Random access 
— Fast access 


In memory representation 
— Regular grid 
— Bilinear interpolation 


Resolution requirement 
— Terrain navigation accuracy is in the order of DIM resolution 
— For typical AUV operations: at least 10 m 


Accuracy description requirement 
— Ideally a spatial statistical description ( grid node depth error ) 
— Usually not available in exchanged DTMs 


Sensor/DTM measurement model 





e We only have a model of true terrain h(x) 
— Horizontal node spacing 
— Interpolation 
— Node depth estimates — Stochastic 


Deterministic 


e Measurements are made towards true terrain X 





Extended Kalman Filter (EKF) 
approach (TRIN, SITAN) 








Linearization for EKF 
requires gradient map 


— Ok in linear and 
weekly non-linear 
topography 


Highly non-linear 
topography handled by 
stochastic linearization 
— Best fit surface 
tangent plane within 
uncertainty area 
— Automatically 
detects non suitable 
terrain 






For each grid point: 


— Calculate mean 
absolute distance 
(MAD) between 
measured and 
expected profile 


Position fix from 
minimum of the MAD 
correlation matrix 


No inherent accuracy 
of fix IS available 


North offset [m] 


Point Mass Filter (PMF) from TerrP 





East offset [m] 





The position error 
probability density 
function (pdf) is 
estimated on a grid 


An initial pdf, depending 
on INS accuracy, can 
be used 


Each measurement Is 
blended with current pdf 
using Bayes rule, anda 
sensor error pdf 


INS drift diffuses the pdf 
between each ping 


Morth offset[m] 
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Particle Filters (PF) from TerrLab 
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Position error pdf 
represented by free 
particles 


Initial state Is 
simulated from INS 
position error 
distribution 


Measurement: Each 
particle is weighted 
using the sensor 
error paf 


Resampling 
Dynamic update 
through simulation 
on INS drift 
distribution 


Terrain Suitability? 


TRIN, SITAN 





e Clearly defined gradients 
e Linear beach 
e Parabolic beach 


e Fjord 






Terrain Suitability? 


Tercom korrelasjonsflate Ormen Lange. 51 målinger, riktig offset 











TERCOM, PMF, PF 





e Rough topography 


e Not self similar 
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Applications 


Cruise missiles 
— Backup system 
— Independent of GPS, cannot be jammed 
Fighter aircrafts 
— Redundant navigation system 
— Terrain following aid for low altitude flying 
AUVs 
— Autonomous missions 
— Covert operations 
Submarines 
— Always covert 
— Transmission of sound is restricted 
— “Man in the loop” 








FFI Developed Systems 





e Terrain Referenced Integrated Navigation (TRIN) 
— MatLab implementation of FFl’s EKF based algorithm 


— Verified in 2 NATO experiments for different AUVs and a 
surface vessel 


e Terrain Navigation Processor (TerrP) 
— Real-time terrain navigation system (TERCOM, PMF) 
— Primarily designed for HUGIN 
— Verified on playback of real data from HUGIN 


e Terrain Navigation Laboratory (TerrLab) 


— MatLab toolkit for terrain navigation algorithm development, 
simulation and post processing 


— TERCOM, PMF, Particle Filters 


